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(54) MOVEMENT CONTROL METHOD FOR UNMANNED MOVING BODY 

(57)Abstract: 

PURPOSE: To accurately move the unmanned moving 
body only by providing a reference mark at an area 
border by moving the body straight according to an 
azimuth detection result in straight movement and 
putting the body in previously set turning operation when 
the reference mark is detected. 

CONSTITUTION: In the straight movement, while the 
moving direction correspond ing to the detection result 
of an azimuth detecting means mounted on the un 
manned moving body is fed back, the moving body is 
moved straight in a preset direction and reference marks 
4 are provided continuously or intermittently in a 
direction crossing the course 3 of the moving body in a 
movement object area 1 , thereby putting the moving 
body in the previously set turning operation according to 
the detection result of the mark detecting means 
mounted on the unmanned moving body. Consequently, 
the reference marks 4 need not be installed on the 
entire movement path 3 and the need for position 

detection is eliminated; and the reference marks 4 are only provided at area borders, etc., and 
consequently the unmanned moving body accurately move along an expected course in the area 
and never deviates from the area. 




h+tn-//www19 indl innit fxn in/PA1 /rfis,j|t/Hfitail/main/wAAABiaizPDA402287708P1 ... 2008/02/15 



® b * m ff (jp) © # » * a & §8 
@^H^fF^^ (a) ^2-287708 

®Int.Cl. s KMC* frP3fflS*# ®&H ¥J£2¥(1990)1I^27B 

Q 05 D 1/02 H 7304-5H 

J 7304-5H 



@m m ^1-109762 

@tB m ¥1(1989)4^288 







m * 


ft 




*dEH&3HH&B3aPr 1 #32^ 


+ 










life 




^dBJWjnfrjfcKwr i #32^- 


+ vr- 




<m 


» # 


HF M 


* 


IS 


^W*KTfJ*K^MW 1 #32^ 






©% 


m # 


* 


* 


Hi 


*Rlff *Krtf *HaOW 1 #32# 






®m 


SB A 






:ttKJR*KftttB£»tr 1 #32*§- 










5tAtt 


















B EB 


* 









« ft * 

i . x *a « * m 

(X) *l£<0*ffex 'J T rtT'^A^W* &^fc5c 

£ *> «>3&£3 tcEii K . f* 

fctf ft fcfc lei it 

«*A*ttflc«0&»M«*f*. 

(2) ^® 

fiSfBf cmjt«*<fe*«&*^K:»ttfc»*« 1 Id 

« © as a * sjj » « & n « w h t& • 

(3) *«as^g*#®8t? ^-efc »K £ co 
a tt o << * & ft m £ it £ ft <n ft A ft t © * B it ti 



fcft#* i B*0*A»» 

(4) v-ir*a#a««a«t^-r^T?* y , c:«d 

(5) ^-^^ffl^a^aa^-f -v-e* y, - © 
dtt?<*&*i:fti&%&ft<D4&£ftfc* ttft^y 

{fcfi©2«m£»tffcK**lS2«©MA**l&# 
<B) *A^8#fc#* 1 #©»lfeft«:tttf T* 

ti-rn&sccffiift-r ^ tc j; *j . #jeG>»**. 
M r fi-e*SA#tt#*-*7ottK: H a -e#»*ifc 

m&KM&*i£XteTi<1tZ s. t t * 0 , &Af* 
ft#«^l&«ft &m^©l£fticii#*& s * ft* 



- 1 - 



—71— 



- 2 - 



(2) 



¥fM¥>2 - 2 8 7 7 0 8 



(7) U T rt-e*iA#I&#£-ft7C 

c ft-* ism &&A^*r# t 

a= lt*A£»#cd Eights * ^ ic u 

fc»##iia*0»A#tttt 

ffl*t«U ^ I* Stt2t«*ffl J: -5 *^tt^3R« 

* * 3 i k*^$^fcMA^»#«)^iiSi|3J»*^k: 

- 3 - 

U:*tt*ill!l*iftfiffifc5fca*. 

«, tj T fc&Ifc U*C b * d RTfrBtt < 

a. 

ffl*l(l)J6?8T'l±, i£&f*»8*tB:a*A#Ilitt*c 

fctfffifcigigs its tat. »B^*xij7^ffl 
MA^»l*:©jfiSfei&««i*^4cjg^^^fcttW 



4£W¥ 2-287708(2) 
*, *c * o r » m * * *> 0 

*c < ** « # # * a . 

- 4 - 

ttAA&m^etc^ocifclc^^rMA^ft^cD 



- 5 - 



—72— 



- 6 - 



2 8 7 7 0 8 



£©iS«&:frffci:Vif©4ftm*£*£&Af*lilt*K 
iEbT*SA#I!l#0E&£ia£a&*6<k3Kb 

< ft ffl > 

minx®*** #&*#as utii b , 
-?&fcmbT&®'r&#*&-Ci&5*&, » J£ ^ 

d £ % £ m . 

*<fcy. jS*A^ft#<D#*mii^i#:£tt&S&K 
|g J$ $ ft 5 - 

- 7 - 

■7 - i? t. u z & m V 4 V X * & - 

£**&^*&^fc&IE^fc&«fc3&te«l 1 aCU 

ifeflt^s ft a . ifa^jg^-ettjgfcgMk 

O^-Vir/i^T^y, i'J71««J|l|:fioTi 
0**F?ffljKSg£ftTMS dCD^jKrffl0« 
^K:ttaa^^4t±£i£«iifc<&#j££:tt$gUej£ 

naBES ftT i^m* J: < , 
<D V < -V tt ^ U T ft K S it 6 ft T ^ ft < X % £ O . 

881 2f J^tgit* h7^ifefeot, #§g 

«^*c^u;^ft3iit!ti 3 &&§rux^a a lib 



2-287708(3) 

# # < & o v b ^-r < & o , H3» 

tfffliilcfcS. dft LXm 3 e>3gl8&. 

fc&Af*i&#©KM;fc&#jEfiK«fcfts. 

< > 

C A3 ® 1 <a&^ 
,*A»ffl*©f*«,««F<!>Wfl & . «2Ht*A# 

s&3 s tcmmmftn-mz *ft-r 

- 8 - 

1 8«:!ft|6«#Tr& *K £ 1 9 tt SIIS * 
2 OttJfctt^&iri/-*. 2ittja«'7'< 

« r ?^^«m-fe>i?-2 lttut&TSK&iifcfcic* 

ft-rftl«T^«^6ft*:lf3/^ry^^-f^2 
la. 21b *e«^3f ftT^*. 

2 3li?l|#ffl03> hn-5tifey, £ 0 3 > 
hD-72 Stt^^^^iJ-h*®*^*^^* 

l*A**-K23a, ffl^iK-h23b. » % 
»&tfAfflA«aife#i4CPU23c. ««3^P 

5R0U2 3d, mmmniC&mZ toZKM* a & 

3g©«fcdt:*ft-rftai>ha~-523 tzmmz 

ft-C*>»J, !^3UC|& bT A^fi!HttA/D^*IB, 
ffi*«l^ttK7>f^@^^i:'(v^-rft^S^tir-r) 



- 9- 



—73— 



- 10 - 



#HfW2- 2 8 7 7 0 8 



*CJS#6D|fc£S:lEt><-fey Htf^-fVi^ft 

js&frv^ £H&<**!n*$i#fi -fe 2 o -earn u 
*i^KiS5gt-s. fit, jaat^ -v^ai^vi*- 

,S£T?|gi£l> (51 4g0^f^S l&tfS2). 
- 11 - 

*i/-*yhL. 6$t*<0@*a»# 

*k a £*-e£>£ -y 4 * * 

*£&¥ft-Ce£*-p£jttiau, ®J tt 7 -f * 4 # 

&m$tiztmm*$L**^* 2 2 & ijty m. 



4*I§*F 2-287708(4) 

iif*«lsll(^f y^S3}55S5), git:* 
Xf^S9»I8l2). »TH««M*i 

- 12 - 

6 it * 9 * 4 tf*m £ 4*4 3&»-a ic 

7 1«ICV-JJ|lB^j|tWff*t»t*7-jf* 
06Hliia« , 7^-V4 *I*3g©xi;71(01J 

tit t m<o 4 vc4r*>*vs <k 0 u -c* a . -rfc 

T!&«7*^4£fcffi-r&a:c^£T'90- b 

i/tiit^u, d^^@at-7>rv4fe^ai^s 



- 13 - 



—74— 



- 14 - 



(5) 



#i¥2-2 8 7 7 0 8 



fr*fc:ai&?^^4fc#ai'r*fcf»SmTi:*fc 

fctdftfc&Jpk LT#&b. ^ft-fftitjiKI*^ 
^e- h 3 > h n -)UT?ffiiE®m 2>ft£4*iEi/ 

-it ft a & &&-r a «> <z> l , # $ * * 



#BB¥ 2-287708(5) 

«#T'i*^»L,<0d£fcL„<&ej£^*ft*ftia 

* 2 2 'J iZ ;/ h jltfiilCjldRai^ll 

fls#*t>*3ft*. ^ i/td eiatoSi^L^ 

* ft 2 * (OiK 9 -f "V IS CD «1t & * & * 



S^fe^f v^S 1 3&tfXr?^S 1 4 i: UT 

^ft-eft«)it«tcjei:T^4aK:^bfc^jiR&ife 
Lrgu^Wtc^jEfft^^a-e^a. 

CBJ »2 toft® 

«« 3 1 ft**.T n 2 H©*A»»* 2 

fcCD±fc^«at^-C&i- *S«tttf3 1 JCttDC 
tf-tf^~*32fc 

— * K ^ >f 3 3 # * ft ft » £ ft "C i? U , =1 
>ha-^23<01«#K£&T*ft^ft!&:&ic8i 
*& 3 ft 3 . 34i±Ji>n-3r. 3 5»:|||g|T'$ 
£ . -9- — jK^-3» K5^/<8 3 l± IB 1 O0tCa<t 
ck}tcA/t/X:&$:/*33a. PID*Jt0 3 3 b , 
PVM K 7 'f 3 3 c^HAt^S. 



2 1 1 a*6©«*CJ:ot«;*-h3 

£ K =y 4 A 3 3©^iI/X*^V* 3 3 a iC&oT 
5&«*e«:&*i©S-]E»*3 lwA^Utt^**^ 

»Tffiftsft. fcAf*»*2 ttm^o^i^^eii 

*-iK*-* 3 2 C&£«E*6Bi:l3Sg 



- 17 - 



—75— 



- is - 



(6) 



- 2 8 7 7 0 8 



*©ffia*ft 3 1 6DB*s#tf J*** * i: £ <k ot® 

3 5 &m 

Iftffift fl 3H3« 1 1 a ^*©fc#}f!^{g 

7 3 3 © *9>£33a®A*Vl~tt 

XlA^XsAUA 5 ft. Ar^S23-ex L i: 
X R tf -eft-Tft^lfi A , BfcJfc&Sft*. @* 
Att^-dft-^ K7-< A3 3©S««I^jig*, B 
&S&ti&*&**< A > B )T& y . A#Jb-e£fttfX 
x * :/ S 2 4 K , B«±-e*ftlUf'^S25 
&gTAf f^S26ifcttS24IC, if:B± 

- 19 - 

CD & y . ( 8 )g«)j:HSI«40*^ 
*t 4* « S K *S U T CPU 4 1 J#-h4 2 *c 

*> *J , y^^T'yvf^ — 3» 4 5 A^SO^lRjlCS 

-t©^©«R^ fi#t>*46 *>P,A/Dgj«lf4 
7 & J& T CPU 4 1fc?-r — K-rty****. atO 

&y. zti&mn* •< a > MWesft y ig£ft 
4 c fc icfc & . 

& h&ULm&jfm*>ni&^& y , ««^4^hv 

« & * a> 6 , £*Bfc^-*&#ffiUTifJ&cl:< 
* c: £ ft £ „ L*u. 

< Wlf* * r £ Si2H0i 



#Bt¥ 2-287708(6) 

y 4> £ ft X ^ * ^ S 2 6Ciii€ft^5. 

CD EI *g # v s , v P ft 5g £ ft . Xf y^S27f 
tf- *K^E~* K 7 ^ 3 3 ^<Da5Jft}g^A^X« 
Sfc#tfSfcj£2ftT&:*)£ft*. 

tiHtttiot 6 6 ft*. 

(CJ £3<&$*J! 
#2E^&9®KwLfcjSA**»l#2<n«*£« 

tf££i:#?T*>fta. 

- 20 - 

dfcffl##5£^ttfc®J:d*rafi tf^ra- 
Sg I 3gfct^-*©f?lbffi«©«S:3l51§Ofc% 

T?a*#epfcW*r$ftTb£trJE»*fttf«Jft. 

(b)0tt«#i>T|g*|gBT***©«*:*2 < 
&y, i£;£ffc £ ftT d ^T- a ©ft Q pi: *i 



- 2J - 



—76— 



- 22 - 



(7) 



- 2 8 7 7 0 8 



t±_tPK& 0 a fc«tcja*-c e> . -©*:«>. & 

&± C T MfWfti^ll ^ * © T- * . 

z:©J:dK. *tS«F ©« < ^"S £ (b)S 

tf^-T <&© K** b ^I&W<Dtftf-JK & t>(a)@ 
©«£fc,±#jfc#m©tfSo£**trba*2<* 
£. * J; o k:*l£3F©« & < b 

tenftM^IZZ & $ iz. * & * V & * 

*^J: y %3f#* -f * V^©ja&]T© 1 / 2 

/< 5 y *«:««©£ 3 K/aaHTfctcJR * y . b* 

C * IH*S b T ^ * <£© D.tOP 

- 23 - 

Zifi. m%-&y 5> y z h5U*ift&&©*¥ 

fc&^0*fe#&©*^#fc©#a«tf£*tir*fc 

b-c-fe^-^^^&^^tc^ox^gdcraiSfeMst 

LT^itf, ffcSfT & c frc J: 

a*att*-et?:' xji/tfxm bfe tj . inifc&tfin 

t> ^> TI *J & &X tt<tj:2>KZKX. V 

r-r a k v> i ra« & * . 

#rCJfr&T«j£t-*;ifcK:<fcoT::©ra&£#£fc 

bfc%©-c*y, - hife t?&^> T 

■9- # IS £ ft & © t? & y . &2@&tf©3Sfc:iJ 



#§3¥ 2-287708(7) 

c:©fti£l*£©jau:3lBbTfc£*i, £*>©"<?& 

%s^^eifiiM««»^K:©*^*<r^«)-c*y. 

&4|g©^«|©&i£©:*^'5/:/S2&t*S8 
©If K &#&©*#«« <t"5^5 ! 'y^S 

tfSll©afriC*l$#|g&*£<rax-r*^S 
3 2&tfS 34 £#Abfc%eDfcfcoT^*- 
CD) 164 ©$5 93 

atft©ie i ©nimicfi^Ttt.. *&&«asbx 

j§SA&»#©£t2l#fft 3 K Lti^. # 




fcic, &*e#©»lE^JH©«*atfir#©#£-K 

SSI 50t»V^t, X,Y,ZttXOYfe*¥H 

h^(X,,Y B ,Z B ), K ,fcfcX*-hH#©:£# 
i?>iMHA{X,,Y,,0), rtttGHJxOiri 
lCT5lfcl«fflI(Xt,Yt,Zt), grttj^tr^ 

©bfc«**-fe>*©fflfl-e&&. 

©itiaCkx.ky)* fig^-fe V * 28©HJi( a J) 
Y,,Z,)S»{!lt5(Xf y^S42), HtXx 

(a , /O&tf £tf #&©*¥M~©»i*;fc& Br( 
kx, ky, a , 0 ) £ »m b , Xx y S 4 4 T lift 
^©^tt©®^**^ 9r- atSr^tmbT^ft© 



- 25 - 



—77— 



- 26 - 



(8) 



mm¥~2 - 2 8 7 7 0 8 



^ltaS^lt*^©t?&S(X^yyS4 5). 

^4fttfJ^>*2 l©Kry^Ty^rJ-f^/2 l a. 
^frl*®^^ ^4 & fcfbUfcB*C&ifctfi5»'1'*>' 

3^tr & f^ifc t y -r a £ t * *tm t ut . *y«t 
&«r?^*4##aKfl#0T?£*>oTv%&!#tc 

WU t^7^3021a, 21bR0©2£» 
- 27 - 

is* wr e > 6 o • ®isk#7-<-v* UT*!i8rir* 



2-287708(8) 

* 3 K LTfctffcf, jfcA#»fl: 2 «D#ffi-f ft^fc. 
m 1 8 BU:z:<Z>8l»^«-e*> 9 , S&4@<DX-rv 

fc£#3©fcr**7y:/3></I/2 1 o taioio 

v= D z /t, © 

*fc. &A#a#2 tfSB^^JifcaSfc* 
ic . jttT^i^©-r*u^^y^Ty^3^;i/2l 

a. 2 1 b«DllJl<0^5S;*t iot. ■? ^ * 
- 28 - 

I j£#©lt3*CD**:f5^> 

< &*5j<JD*&:fc > 

5*tt*<, ^ ti T### if tan*-*-* fcKtfT 
< ^^©Sli»k:»o T XE«£#* £ it* d 



- 29 - 



—78— 



- 30 - 



- 2 8 7 7 0 8 



^ - 1 tc j; , fiiieamoffittffl^-^ 

"rff fig 

JEfc*4«>»wic**n<. tame 



2-287708(9) 

4 . BIS ®ffiJ&&fit$ 

2@M:^^JS*lOiteA^«r^<D-^S^-r«E«* 

fcttK:#tfS#fc:tU7fc*SAi£»#<»l**m*& 
^9Ktt<g2«D^^©-||«tWfcfiW5^A^ 

a. m i o @ttfmnafcw®#j«@ 

|gl2@ttJ&3©&Ji§KW£Ufc&fcfl$i#P0 



i-#«i'jr, 2 -j^A^a^.- 
i8-e<i# t i 9 

»m#a), 2 o >^(*fe«jaj^ 

© ) > 2 1 a X. I* 2 1 b-lfyfT^a^I/, 
2 2 -igi&IK* ^ > * , 23-3yhB-9. 2 

3 1 32-DC*- 
riC * - * , 3 3 -t- - it K ^ -f * - 

ft a a «i ra * 



- 33- 



—79— 




—80— 



#i¥2- 2 8 7 7 0 8 



#M? 2-287708(11) 





—81— 




—82— 



«MM¥2 - 2 8 7 7 0 8 



2-287708(13) 





—83— 




—84— 




—85— 



mmW-2- 2 8 7 7 0 8 



#W¥ 2-287708(16) 



S 51 [^^3 




0 18 a 



> START 



U*7 

-fe.>»>vO 



1ST- 
1^7 



INC 



*4 



£#7 



INC 



JfcS*7 



INC 
0 19 H 



4* 



^^7 



—86— 



